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ABSTRACT 


The interactions of control system and distributed flexible 

structural dynamics is explored for mechanical arms. A modeling 
process using 4x4 transfer matrices is described which permits 
the closed loop response of many current arm configurations 
to be evaluated. Root locus, frequency response, modal shapes, 
and time impulse response have all been obtained from the digital 
computer implementation of this model, which is oriented to 
arm design and allows for easy variation of the arm configuration 
through data cards. The model corresponds with experimentally 
observed natural frequencies with an average error of less than 
5% in the first three flexible modes in the seven cases considered. 

The model was used to explore the limits imposed by structural 
flexibility on a nondimensionalized two link arm with one and 
two Jointe for planar motion. Using simple position and velocity 
feedback and careful adjustment of control gains adequate damping 
(damping ratio of 0.65) can be imposed on dominant eigenvalues 
which have a complex modulus of more than one-half the cantilevered 
frequency of the arm with all Joints clamped. The limitations 
imposed by flexibility are roughly compared to strength limitations 
to indicate when flexioilicy will tend to be the more immediate con- 


straint on aim design. 
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INTR ODUCTION 


The goal of chis study was an improved understanding of the interaction 
of the various design components of manipulator arms so that arm design in the 
future would be based on more reliable and more logical procedures and tools. 
As a significant step towards that goal an arm modeling procedure has been 
established and implemented on the digital computer. This implementation is 
design oriented, allowing for easy alteration in the arm configuration and 
parameters. It focuses on an area previously ignored by design procedures: 
the flexibility ot the various structural components and the interaction 
of that flexibility with the joint servo control to affect dynamic perform- 
ance. The model implementation is based on frequency domain techniques and 
yields to the designer such information as natural frequencies, complex 
eigenvalues, mode shapes, the system frequency response in the form of Bode 
diagrams or polar plots, and via its inverse Fourier transform the time 
Impulse response. This model has been verified with several experimental 
cases by comparing natural frequencies. It has been used to explore the 
Interaction of structural and servodynamics for simple but reasonably 
general arm configurations. The rules developed appear to be reasonably 
valid for more complex models and thus as a first approximation for design. 

Additional work, has been done in expressing the laws of scaling for 
arms relating the mass moment of interia which limits gross motion speed 
to the limiting servo bandwidth which limits fine motion speed. 

Arm Model 

Since the arm model, its implementation and verification are an 
important product of this research, its rationale, features, verification 
nml limitations will be discussed in some detail. 

Model lnj$ Rationale 

Out of a number of possible models a selection has been made which 
results in features and limitations. The rationale for the selection will 
be discussed in the design context in which this study was carried out. 

Smal l m otions about a reference position . The most pervasive decision in 
the modeling process was perhaps to separate gross motions from small motions. 
This enables one to describe the arm as a linear system. The nonlinear 
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equations of motion for a rigid arm are quite complex and lengthy and 
the general flexible case seems beyond present capaoilici.es. A linear 
model also allows for better comprehension of the issues of design. 

Aside from convenience one must discuss the validity and pertinence of a small 
motion model. The validity of the model to describe small motions is supported 
by the experiments discussed later. The pertinence of a small motion model 
to the design question is claimed on the basis of the following: 

1) The frequency of structural vibrations is such that many cycles ( 
will occur before the configuration of the arm has significantly changed. 

Thus the interaction of the control system and structural flexibility is 
well described by a small motion node!. 

2) The first order effect of the gross motion on the structural 
arm vibrations can be represented by a disturbance loading, which is ade- 
quately described by the small motion model. 

3) In most manipulator tasks the most stringent position accuracy 
requirements, therefore the most need for consideration of structure/servo 
interaction, occurs when the arm configuration is not rapidly changing. 

Mixed Distri buted Lumped Mode l. Observing manipulator arms of various designs 
one will find for general purpose arms one or more slender members which 
generally support the forces both transmitted to the payload and generated 
by the body forces of gravity and acceleration on the arm itself. Although 
these members are frequently not smooth enough to be called beams the 
contention here is that they can be modeled as such. Their compliance is 
most significant when supporting bending or torsional loads. If a signif- 
icant portion of the mass of the arm is distributed throughout the length of 
this member, the distributed nature must be recognized in the modeling. The 
most straightforward approach is to describe the arm using partial differen- 
tial equations. Alternatives such as lumping the mass and flexibility of 
the beam into separate elements approximate the distributed nature but 
require validation and tutting by checking with the corresponding natural 
frequencies of the distributed counterpart for example. This is especially 
cumbersome in design when the correspondence would be in doubt for each design 
parameter change. 

A beam is considered to be distributed in one dimension only, which is 
reasonable for most arm models. It is conceivable that distributed effects 
in two or three dimensions would be important, but a model valid for design 
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purposes can be constructed in most casus without this complexity. 

Ocher elements which are appended to tne beam clement such as joints, 

* actuators, and some payloads seem to contribute essentially mass or essentially 
compliance and are more conveniently considered as lumped elements. The 
control action itself is concentrated at the joints of the arm and thus is 
well consided as lumped. The lumped parameter dynamics are described by ordin- 
ary differential aquations and in this case the equations considered will be 
linear. 

It is not intended to imply that by including distributed elements modeling 
the physical components of an arm or arm design will be without need for desip nr 
Judgement. Selecting from the possible model elements will improve with exper- 
ience and the ultimate success of a model will depend on experimental fact. 
frequency Domain M o del . Frequency domain techniques, while still a workhorse in 
many practical applications are not currently the vogue of controls engineers. 
State space models, with optimal control determined in the time domain are 
more popular and yield promise In many areas Including manipulators. In the 
flexible arm design context they lack the versatility and ease of model con- 
struction and alteration that results with the present model. 

The problem is especially acute with the mixed parameter problem at 
hand. Beam vibration control studies in the time domain have been published 

(1) ,(2), (3), ai ng i e uniform beams. A manipulator model based on a 6ingla 

distributed beam described in terms of its lower inodes of vibration with control 

(4) 

optimization in the time domain Has been studied by Mlrro . When connecting 
two or more distributed beams the problem of boundary conditions between 

^ Koehne, Manfred, "Optimal Feedback Control of Flexible Mechanical Systems" 
Proceedings I.F.A.C. Symposium, Banf , Canada, 1971. 

(2) Komkov, Vadim; "Optimal Control Theory for the Damping of Simple Elastic 

Systems", Lecture Notes in Mathematics No. 253, Springer-Verlag, 

1972. 

13 ) Van de Vegte, J.. "Optimal and Constrained Optimal Controls fer 

Vibrating Beams", JACC Atlanta, Georgia Session Paper 19-C, 
p.469. June, 1970. 

(4) Mirro, John, "Automatic Feedback Control of a Vibrating Flexible Beam" 

SM thesis, MIT Department of Mechanical Engineering, August, 1972. 
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tut *= ■'stems of partial differential aquations restricts tine domain 

mod* ** severely. Lumped parameter models of flexible arms are discussed in (6). 

Frequency domain techniques have long been available for beams 
but the technique is not frequently used in the context of control 
of distributed systems. The boundary condition problem is very con- 
veniently solved utilizing the sequential (one dimensional) nature of 
beams and of arms in general. The numerical techniques are relatively 
straightforward. The lack of a mathematically convenient optimality 
criteria is not in itself a severe restric tion cince there is no concise 
definition of optimality for general purpose arms anyway. The frequency 
domain techniques will be discussed in more detail in a later section. 

Arm Modeling and Implementation 

This section will discuss the procedure used for modeling. Its 
implementation, and the results that can be obtained. 

T ransfer Matrix Approach 

The transfer matrix approach provides a versicile method of describing 
the interaction between the linear components of a system when that inter- 
action occurs at no more than two stations of the component. For beams 
these two stations correspond physically to the two ends of the beam. 

For pure rotary springs these stations correspond to the ends of the 
springs. For rigid body inertias these stations correspond to the points 
of attachment. When three or more components interact at a single station 
it is still possible to use the transfer matrix approach if this inter- 
action is well defined. The transfer matrix method is well explained by 
(5) 

Pestel atH. Leckie and only the ess ials will be discussed here. 

The interaction between two components is described by means of a 
vector of state variables. At the station between two components the 
value of the state variables is Identical. A transfer matrix is used to 
describe the relation between the state variables at’ the two stations of 
each component. If the component is a Static component (does not involve 
differentials with respect to time) such as an Ideal spring, the transfer 

(5) 

' Pestel, ixluard C. , and Leckie, Frederick A., Matrix Methods in 
Klasto acclianlcs , McGraw-Hill, 1963 

(6) Book, Wayne J., "Study of Design and Control of Remote Manipulators, 

Part Ti Vibration Considerations in Manipulator Design" 

NASA Contract NAS8-28055, N73-20138, Feb. 1973. 
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matrix Is a function only of the component parameter*. For 

dynamic component* such as an ideal mass, the transfer matrix Is also a 
function of the time derivatives of the slate variables. For llneer 
components (dsscrlbsd by llnesr differential equations) it Is convenisnt 
to deal with the Fourier transform of these equations which yields 
the steady state amplitude and phase (or complex amplitude) of the state 
variables under a pure sinusoidal excitation o:.' frequency u. The 
transfer functions for these components are functions of 

The state vector z that is used in the arm models consists of fo>.r 
variables displayed in Figure 1 for a beam with flexure in the x-z 
plane. These four state variables are sufficient to describe most arm 
vibrations of Interest. Arm flexure in two planes can be described if 
chase motions are decoupled. In addition torsional compliance of beems 
can be accounted for when vibrations out of the plane of two beams is 
studied. The sufficient conditions for decoupling the motion ere discussed 
later. In general the neutral axis of the undeformed arm must lie In a 
plane for these four state variables to sufficiently describe the arm. 

Two link designs which pradomlnats arms built today (except for short 
wrist segments) automatically qualify. Additional am links or beam 
like supports modeled as part of the arm may of course be arranged in 
nonplaner configurations. There is no conceptual difficulty in extending 
the state vector 'o the complete three dimensional case. The twelve 
state variables then needed (flexure in two planes, twisting, and com- 
pression) lengthen numerical computation disproportionately to the 
Information attained. State vectors with between 4 and 12 variables 
may give added information in some specific cases. Four state variables 
are all that will be considered here. 

For decoupled motion it is sufficient for small motions that a planar 
arm have its joints either in or perpendicular to the plane of the arm, 
which is usually the case. For a typical arm two sets of data describe 
the small motions of the arm. One includes only flexure. The other 
includes distributed flexure and a lumped torsional compliance for out of 
plane motion. For anus that CAn be configured so as not to meet the 
requirements for decoupled motion an extended state vector or a configur- 
ation which does meet the requirements can be studied to obtain design 
information. 


fi 
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Given the transfer matrix B for a component and the state vector 
at one of its station* the state vector * ^ at the other station 

is given by the matrix mult ip fleet ion. 

11-1 " 8 IX 

Zt ie thus e simple matter when components ere connected ecrislly (two 
components per station except for the end components) to find an overall 
transfer matrix by multiplication of the Individual matrlcea to eliminate 
the intermediate state vectora. This is demonstrated for an arm model in 
Figure 2. 

The elements of the transfer matrices for various components are 
illustrated In Figure 3. The expressions are developed from the differ- 
ential equation factored into time and space functions which can then be 
solved independently. The developments will not be given here but Figure 
3 displays th* results, many of which ara developed in (5). 

Modal Imp lamentation and Use 

Included in this section will be a brief description of the computer 
programs used to implement the modal including the basis for tha computations, 
the type of input and output involved, and its meaning in the context of 
manipulate r design . 

Information available from the model Includes natural frequencies , 
complex eigenvalues, the steady state frequency response, the inverse 
Fourier transform of this response which is th* dm* impulse response, and 
the eigenfunctions which srs th* arm shapes when only one mode has been 
excited. 

Numerical Operations with Transfer Matrices . The product of matrices such 
as appears in Figure 2 essentially is the implementation of the model of 
the arm which consists of beam s, lumped messes, controlled joints and angles, 
joined end on end. The implementation of the modal provides ways of getting 
useful information from that model. One possibility is to express analytically 
the elements of each component matrix, multiply the matrices end obtain s 
single matrix each element of which la a sum of products of the original matrix* 
While t) .s is in fact done for a simple case in Appendix A, it is not recom- 
mended tor more complex cases unless the same configuration is to be used many 
Limes. The alternative is to evaluate each term before the matrix product 
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is taken, thsn multiplying the numerical values. This is a procedure 
which can be carried out in a straightforward fashion by digital computer. 

Hie advantage to numerical evaluation of this nature is that the 
complex functions need not be manipulated avoiding large amounts of 
designer time and potential for mistakes. 

The disadvantages are of three types; 

1) More computer time is required to evaluate expressions 
which might be simplified using trigonometric and hyperbolic 
identities. The simplification is not apt tc be great unless there 
are identical components or at leaat many identical parameters. 
Additional computer savings may be obaerved vhen some of the 
transfer matr;c a havt many zero or unity elements. Straightforward 
multiplication of theaa takea as long for the computer as do non- 
zero or non-unity elements. It may not be difficult for the dealgncr 
to combine several simple elements into one matrix analytically 

If this combination is to be used frequently. 

2) Numerical arrora may becoma significant. The larger 
nuwber of calculations may cause roundoff errors to become slg- 
nif leant especially in some cases (evaluation of determinants) which 
require taking the difference of two large » nearly equal numbers. 

This difficulty has bean aneo>:4tered only in rare end unusual cases 
and been solved by using extended precision in those cases. It is 
also possible to get a numerical overflow In the product of the 
trenefer matrices. 

3) For simple ceeee the analytical expressions resulting from 
the matrix product may give the designer insight into the problem 
that the numerical results obscure. 

boundar y Con dit ions and F orcing Functions . The transfer matrix, whether it 

describes a single component or e group of them, expresses the relation 
between the state variables at lta two stations. In order for the transfer 
relation to he valid between state vectors, at moat four of the eight state 
variables may be arbitraily established. In fact for physical systems only 
two of the state variables At each station may be determined and more 
precisely for these state vectors only one of the associated variables of 
displacement or force end angle or moment may be arbitrairly specified. This 
specification may be as a simple boundary condition, as a forcing function, 
or as a linear combination of variables which may implicitly include the other 


variables, of cue bane state vector. This last ca„e is in essence vhac 
one does when he appends another component by multiplying another 
transfer matrix. In this case one merely transfers the specification 
to another station in the extended system. 

For simple boundary conditions one prescribes two non-associated 
variables of the arm. Figure 4 displays the physically possible 
combinations of zero state variables. The non-trivlal solution of this 
case can result in solving for the natural frequency of complex eigen- 
values (for damped systems). Additionally one can solve for the eigen- 
functions of the system (the mode shape at the eigenvalue'. The imposition 
of a forcing function yields the steady state forced response of the 
system, assuming the forcing function is a sinusoid of frequency w . 

These techniques will be discussed in the following sections. 

Natural Frequencies end Eigenvalues 

If disturbed from Che equilibrium position end then allowed to 
move freely after t»0 (without disturbance or outside input) the state 
variablee of e linear system will be deecribed over time by a function 
of the form 

(1) -a .a J “j* + S 2 e^ w 2t + aje^ + ...a^ 

*1^ ■ the i th element of £ ^ 

For a lumped system there will be a finite number of these terms while 
a distributed system may theoretically have a ccwntably infinite 
number . 

If or undamped systems the wt appear ae the frequencies of vibration 
and assume real values. For damped systems some of the will have 
complex or pure imaginary values and it is more conventional to deal 
with the eigen valued sj[ " j w i* Complex or pure imaginary values of s 
(complex nr pure real values of u ) will always occur in pairs with the 
same real (Imaginary) part and an imaginary (real) part with the same 
absolute value and opposite sign. When this is the case we will deal 
explicitly only with the value of s (<*> ) with the positive imaginary 

* The assumption here ie that the are distinct. For physical systems 
this is always true if one cares to look at the values with enough accuracy. 
The more general case w i ■ w ^ does not restrict the results presented. 
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(real) pare. 

The value* of*^ for an arm system modal dapand only on t.* 
paramatara of, and cha boundary condition on. tha ayatam. They are 
indapandant of initial condition*, independent of which atate variable 
1* observed, and independent of the point in the system at which It is 
being observed. The values a^ depend on all of these quantities. 

Tha time function (Eq. 1) which describes s state variable of the 
system must ba consistent with the differential equations of the 
individual components, the general solution of which is the same form as 
Equation 1, al30 involving terma This general rolution is the 

source of the transfer matrix for tha component. For an Isolated single 
component the rest of the rest of the system acts as a complex boundary 
condition which must ba considered when determining the values of the 
u for that component. The state variables between two components assume 
values over tine that must conform with tha general solution of two sets 
nf differential aquations. This can only occur if the values of w are 
the game in both solutions end In fact the seas as the general solution 
for the entire system. 

The transfer matrix technique allows one to simultaneously consider 
ell the components and the boundary conditions on the system and thus 
determine the m of interest. Multiplying transfer matrices eliminates 
the intermediate state varieblea at the interface between components 
end expresses state variables at one end of an arm directly in terms 
of the other end. Imposing two boundary conditions at each ends 
restricts tha values w i can assume for e nontrivial solution of the 
remaining state variables. These are the seme ^ appearing in Eq. 1. 
The restriction le developed in Fig. 5 for specific boundary condition 
on a specific arm model. In general for a system represented by a matrix 
product U such chat 
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With tne boundary conditions 

z Jrt " “ 0 at station 0 

10 JQ 


and z, f 0 , 2 ^0 at station n 

ltn *-n 

(implying the remaining two variables at station n are zero) 
acquires for a nontrivial solution that the frequency determinant 


2) d 


u ik 

u jk 


j 

i 

uU ! 


u ik u jl “ u i* 




U) * 


Tne elements of U and thus the terms of the frequency determinant 
are generally complex functions of u • This being the case one must 
numerically search for values of u> where d*»0. When dealing with systems 
with no damping one can restrict the search to real values of u or complex 
valuta of the eigenvalue a. In general however, one oust search over the 
complex plane for values of s*s^» where both the real and imaginary parts 
of :i arc zero. In order to us e conventional search routines one can search 
for minimum values of ||d\| " { linn" d) ? +l£ed)* , then check to see if 

d* 0+ JO for the values of s returned. This topic will be discussed In more 
detail in a later section on numerical implementation. 


IX 


Modal Shape s 

Associated with aach eigenvalue is an arm shape called the modal shape 
which describes the relative amplitida of all points of the arm when 
vibrating at that frequency. Looking at the problem from another perspective, 
there is an arm shape which when it constitutes the initial condition will 
result in arm vibration describsd by a single eigenvalue, to the exclusion 
of all other system eigenvalues. 

The transfer matrix method can be employed to find the mode shape 
after the eigenvalue has been found. Refer again to the equation 

£0 " u 5n* 


Two of the state variables at each end are specified by the boundary 
conditions, and the remaining fou- state variables can be solved for 
in terms of each other. By normalising one of the state variables to be 
equal to one the remaining three are specified. 

More specifically consider the boundary conditions resulting in Equation 
(2). The homogeneous equations which preCced ths frequency determinant 
are 


| u ik 


“i * 
u 


*1 

’*in 



J 

L 


If z. is required to equal one, the solution for z is 
In J n 


z jn - * l U Jk 

u ii v 

Selecting the appropriate 2x2 submatrix from u will enable one to solve 
for the unspecified state variables at station 0. 

Lit order to visualize the modal shape values of the state variables 
at intermediate points &ee helpful . For this one must refer to the transfer 
matrices of the separate components. For lumped components the knowledge 
of the state variable at either end is usually adequate for visualization. 

For distributed beams, however, the trigonometric and hyperbolic functions 
describing the shape within the component are far from obvious. For plotting 
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chase functions one can essentially divide the component into smaller 
cosponents thus creating additional intermediate state vectors (for purposes 
of plotting only, not for finding eigenvalues). When plotted versus 
distance along the axis of the arm the state variables Indicate the shape, 
angle, moment and shear amplitudes along the arm. 

Steady State Frequency Raaponse 

In the previous section two state variables at each end of the arm 
were specified to be equal to taro, thus establishing simple boundary 
condition which enabled one to search for the eigenvalues of the arm system. 
Another way to specify the system is to impose sinusoidal forcing functions 
of frequency ft and arbitrary but constant amplitude on from one to four 
of the state variables (subject to the same constraints on combinations 
of state variables as for boundary conditions Indicated in Figure 4) . The 
procedure here is actually mors straightforward than for finding eignevalues. 

Consider a linear system with at least a small amount of damping (present 
in all physical systems) forced by a single sinusoid of constant frequency 
for some appropriately long time. The response of that system at any point 
will be described completely by e complex amplitude times a sinusoid of the 
asms frequency A . Alternatively the response could be described by e real 
amplitude and a phase angle. This complex amplitude as a function of ft 
termed the steady stats frequency raaponse. 

Consider once again an arm modal with describing transfer matrix u. 
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Assume the rows and columns of tf arc rearranged to form 0 such that the first 
two state variables of the rearranged state vectors zq and are forced 
With a sinusoid of arbitrary but constant complex amplitude. Then 

*0 ’ S *n 


Let us partition this matrix expression such that 
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and f contain the forced state variables and r,, and r contain the 
- u -n --0 ~n 

remaining state variables, termed the response variables. 


3) 

4) 
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—0 21 ~n 22 — n 


solving explicitly for r. and r 

n 

from 3) r u - U l2 t Q - U 12 1 U u X n 


from 4) r 0 - u a f n + U 22 (U', l 2 lo - u 12 - l Un f n ) 
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Assuming U 12 exists. 


Equation 5) expresses the four response state variables in terms of 
the four forced state variables. The value of w at which che transfer 
matrices will be evaluated will be the forcing frequency ft . The forcing 
vectors f.. and f will contain tha ( possibly complex and distinct) forcing 

“v * a* 

amplitudes. Complex amplitudes can be used to represent a phase shifr 

between the various forced state variables. r_ and r will contain 

— u — n 

the amplitudes of responses. 

In practice it is seldom informative to force more than one state 
variable simultaneously. Then it is possible to simplify equation 5, 
assuming there is only one non sero element in f^andf^. 

Once again it is usually preferable to numerically evaluate the In- 
dividual component transfer matrices prior to multiplication, enabling 
straightforward Implementation on the digital computer. 
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Impulse Time Res po nse 

It is well known that the steady state frequency response is 
equivalent to the Fourier transform of the impulse time response 
for linear systems. This has long been used to obtain the power 
spectral density from time records. The inverse transform of the complex 
frequency response (which contains magnitude and phase information) can 
thus be used to obtain the impulse response. This enables one to visu- 
alize the system time response to an impulse disturbance. Thus if one 
desires the impulse response of a given state variable, displacement 
w(t) for example, to an impulse disturbance at another state variable, 
sheer force V at the same station for example, one first uses Equation 
5 to solve for the frequency response of that variable, in our example 
w <jw) . One then uses the inverse Fourier transform given hy 

6) *ui (t > ' .[ ‘hi «“ > Wt d “ 

h * response state variable index 
i * response station index 

to determine the time impulse response for example w(t). 

In practice we desire to evaluate this response digitally using discrete 
samples of both the time and frequency responses. This introduces 
a great number of subtle consequences which will not be discussed in this 
section. Suffice it to say that the Inverse transform can be performed 
economically with a slight change in the very efficient FFT (Fast Foruier 
Transform) algorithm (7 ) . The use of the algorithm in the inverse 
fashion is not well documented and will be discussed in a later section. 

Exp^ rlr ert.-I * 're flection o* fr-; **ode1 

To get some indication of the accuracy of the model two sets of 
experiments have been performed. The first of these is summarized in 
Figure 6 and Table 1. The second is summarized in Figures 7 and 8 and 
Table 2. in both cases, the predicted natural frequencies of the undamped 
systems are compared to the resonant frequencies observed when forcing 
the system with a sinusiodal torque. In the first set of experiments, 
the frequency was determined via stroboscope. The second experiment 
was conducted by Octavio Malzza-Neto, also in the Department of Mechanical 
(6) tier gland, G. D. "A Guided tour of the Fast Fourier Transform", 

I FEE Spectrum, July 1969. 




Engineering at MIT. It was performed using automatic frequency 
sweeping and measurement of the amplitude of the endpoint of the 
system via accelerometer. 


Table 

1. 

Results 

of Experiment in 

Figure 

6. 
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Table 2 Comparison of Predicted and observed (Fig. 7) 

Natural Frequencies - Experimental Case 


Model 

Experimental 

2 Error 

(hz) 

(hz) 


77.2 

80.76 

4.32 

145.0 

136.6 

6.02 

278 

244.6 

13.82 

477 

(401.6} 

(18. 82) 


(417.0) 

(14.42) 

7*5 

688.3 

15.62 

1063 


(23.82] 

1893. lj 

]l9 2 j 


1366 



1591 



* 
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Figure 8 plots t:u; acceleration amplitude measured versus frequency 
for this case. 

The motor rotor inertia waa the only value which could not be 
measured. Table 1 la based on values of that parameter taken from 
a motor catalogue. By using 30% lower values the maximum error was 
reduced to 3.7% for the first three natural frequencies. Thus it is 
possible that the errors in Table 1, although not excessive (averaging 
4% do not do the model justice. 

Predictions of the first three natural frequencies appear good in 
both cases, with accuracy decaying after that. Figure 8 displays 
acceleration amplitude. 

The decay of the amplitude peaks indicate that the first two 
inodes will dominate the response. This decay will be even greater 
for displacement amplitude. To obtain the relative magnitude of these 
peaks one roust divide by the frequency squared. Table 3 shows the 
relative amplitude of the first six nodes for acceleration and 
displacement. 


Table 3 Relative Amplitude of First Six Resonances 


Number 1 2 3 A 3 6 


Relative 

Acceleration 


.868 .162 .226 .166 .170 


Relative 

Displacement 


1 .304 .0177 .00914 .00229 .00150 


The quality of the data seems good in both cases. The multiple 
peaks at some resonances in Figure 8 are probably due to the constantly 
changing frequency which does not allow the beam to reach steady state, 
and with die mixing of two nearly equal frequencies from the torque motor 
and the beams produces a beat like phenomenon. 

For Lhu higher modes a decay in accuracy is not surprising. Since 
Che total motion involved in these vibrations is very Bmall, nonlinear 
effects such a s backlash from the nonzero tolerance at the joint become 
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Inverse Fourier Transform via Digital Methods 

The calculations of the snail motion response ot the arm system have 
been carried out in the frequency domain. This intormatlon is related 
to the time domain response via an almost symmetrical pair of trans- 
formations — tne Fouriar transform and its inverse. It is at best 
awkwaru to perform these transformations via analog hardware, and In 
view of the digital nature of the calculations to this point digital 
calculations sre preferred. This Introduces distortion due to sampling 
of continuous phenomena. 

The digital Fourier transform (DFT) end its inverse have exact pro- 
perties in themselves and can be used to approximate their continuous 
counterparts. This can be done most efficiently using the algorithm 
known as the fast Fourier transform or FFT to compute the DFT. Only 
by understanding the DFT can the sampled approximation yield infor- 
mation on the continuous case with the least distortion and greatest 
efficiency. 

Fourier Se ries for Continuous Functions . For s periodic time function 
it is well known that there exists e representation in terms of a 
weighted sum of sines and cosines, or in terms of complex exponentials 
which are harmonics of the fundamental frequency ft. This le called 
the Fourier series; „ 

(7a) f(t) - £ ^ F a exp (jftt) i - . . .-2, -1,0, 1,2,, . . 

Where j - J -1 

ft ■ the fundamental frequency in rad/ sec 

more significant, because of the small amplitude it is not felt that this 
significantly affects the model for practical use. 
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T/2 

(7b> F i - j f<*> «xp (-j int) dt 
-T/2 

Whsr* T *» 2ir/Q ■ Period of on* cycls in sac. 

The F^ are the Fourier coefficients. 

It is usually possible to truncate the series at a finite number of 
harmonics, which depends on the accuracy desired. 

For aperiodic functions it seems intuitive that T goes to infinity 
and ft ■ 2rr/T goes to aero. In fact in the limit 

(8a) f(t) m { ?(Jw) **P (Jwt) duJ 

■»4M 

(8b) f(jw>) ■ [ f(t) exp (-Jut) dt 

F(jw) is the Fourier Integral end is equivalent to the Fourier transform 
of the time signal. 

The above are true for any time signals regardless of their origin. 
Certain additional relations will hold when the time function is the 
response of a linear system. When f(t) is the response of a linear 
system to an impulse input to one variable at a point in the system 
at t«0, F (jo.) is the steady state frequency responae resulting from 
a unity amplitude sinusoid forcing the same variable. This is in fact 
what is obtained from the frequency domain arm model. 

D iscret e Approxim at ions . Starting in either the frequency or time 
domain, one can at least formally transform to the other domain via 
Equations (8). In practice however one must approximate the transform 
by replacing the integration with summation and replacing the dif- 
ferential du with the increment Aw resulting in 
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n 

I F(Ji Aw) exp (ji Awt) Aw 
i"-n 

n 

l F (Ji Aw) exp (ji Aut) 
l--n 

by comparing this with Equation (7) one realizes that this approxi- 
mation must be periodic and of period 2ir/Aw , indicating that dls~ 
tort ion of some sort has occur ed. 

Certain steps must be taken to assure that the distortions re- 
sulting from the discrete approximations do not render the approxl- 

A A 

mate time response f(t) useless. For f(t) to result from a stable 
physical system the response for t<0 (before any input) must be zero. 
Noting in Equation (8b) the two sided nature of the Fourier integral! 
and recalling the periodic nature of f(t) one can correctly conclude 
chat the results of Equation (9) must be at least approximately 
zero for half of each period. This requires sufficient time for the 
Impulse response to settle out, placing a lower constraint on the 
period 2ir/Au (or upper constraint on Aw) . 

It is not readily apparent in the frequency domain what an ade- 
quately small value of Aw la. If one knows the location of the system 
eigenvalues he can estimate the settling time of each exponential. 
For complex conjugate root pairs for example 


Where £ * damping ratio of the root pair 

“ distance from origin of the pair 

t^ « time to point where response remains within 
22 of steady state 


(9) f(t) « f(t) - - 


or 


ho - g 
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One may make Lu smaller by either Increasing the number of samples 
or by limiting the upper value of the frequency response considered. 

By lowering the upper value of frequency Q f that will be considered 
one removes the components of the time response with frequency greater 
than 8 . By looking at the frequency response for the system one can 
estimate il^. Resonant peaks that are not down at least 20 db. from 
the magnitude at w-0 should be Included if feasible. Thus for given 
settling times and given frsquency one arrives at a minimum sampling 
interval in the frequency domain analogous to tha Nyqulst sampling 
intarval in the time domain. Just as r&t’l time Intervals between samples 
are required to evaluate the frequency response for lsrge frequency, 
smell frequency intervels ere required to eveluete the time response 
for long timet. 


n 
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Numerical Implementation 

The arm modeling method has been implemented on a digital computer. 
This section will describe briefly the program and how the user may 
interact with it. Also described are msserical difficulties that have 
arisen in use and how they have been handled. 

Computer Capabilitie s 

Although it was originally Intended to Include all the programs 
in one package for Interactive use by the designer , this goal has 
been abandoned for the present time due to the modest core storage 
of the machine used. The Xnterdata Model 70, with 40K 16 bit words 
of core storage at the M.I.T. Joint Civil-Mechanical Engineering 
Computer Facility was used. Thia is a mini computer handling inter- 
active graphics and console input which is very useful in a design 
situation. An Interdata Model 00 with 32K 16 bit words of storage 
was used for some of the more extensive eigenvelue searches dus to s 
lower price structure end e fester CPU , The program ss it presently 
exists is divided into several compatible packages. Table 4 classi- 
fies the programs in seven mors or lass related categories. These could 
at some point be combined into cu Integral program with complate 
communication batwean all ths program parts. Catagories I. It, and III 
utilise descriptions, of the arm and aubroutinea in VI and VII 
Catagoriaa IV and V use output from II end III to obtrln additional 
information. 

Nature of User Input 

This section will briefly describe ths nature of ths user inout to 
ths system to indicate ths designer effort required (not to indicate 
how to use the programs). 
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Table 4. Program Category Outline for Numerical Implement ition 
1 Natural frequency calculation (.no damping) 

A. Single Precision 

B. Double Precision 

II Eigenvalue search (two dimensional searcu, systems with damping) 

A. Card and console input only 

B. Interactive graphics implementation 
III Frequency response calculation 

A. Logarithmic frequency scale 

1. Bode plot 

2. Polar (Nyquist) plot 

3. ‘lodified polar plot 

B. Linear frequency scale (equal increment in frequency for 
PFT input) 

IV Mode shape calculi cion and display 
V Fast Fourier transform 
VI component transfer matrix calculation 
A. Distributed Beam 

1. Bernoulli -Euler model 

2. Timoshenko model (includes shear and rotary inertia) 
li. Rigid Body 

1 . General 

2 . Uniform cross sec Lion 
c. Angle in the arm shape 

1. In the plane of vibration 

2. Perpendicular to tha plane of vibration 
U. Controlled Rotary Joint 

1. Transfer function control 
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l. Witn flexible shaft and gear reuuction. 

L . Parallel elements (combines certain elements in parallel by 
clamping them at each end). 

K . discontinuity in one state variable (with its associated 
variable equal to zero eg. pinned connection between bean-, 
or pinned connection to ground) 

VII Search Routiner. 

A. Pattern search - 2 dimensional 

b. iiJM SSP root finding algorithm 


Arm Description . Th* description of the srm to be modeled is in terms 
of the srm elements or components selected from Category VI of Table 
4, Each element requires one end sometimes more data cards giving its 
parameters and are arranged in the order of occuranca on the arm. In 
certain cases there sre restrictions ss to what combinations of ele- 
ments can be used. For instance angles in and out of the plane of 
vibration would result in a nonplanar arm which cannot be handled by 
four state variables. Other restrictions Include 1) arm discontinuity 

can be used only with natural frequency or eigenvalue (1 and II) 
calculations as presently implemented. 

2) Parallel elements cannot be used with mode shape calculations. 

3) Flexible shafts incorporated into the controlled joint must 
connect to s pinned* clamped, or sliding end of the arm. 

Calculation Description Input ■ Presently the description of the de- 
sired calculation for natural frequencies end frequency response require* 
one card for describing srm boundary conditions, calculation type, 
number of increments, end extreme frequencies considered. In addition 
the forcing variable must be specified for frequency response cal- 
culations. A number of selections of output alternatives and extended 
calculations ere available by data switch and console isnut at run 
time. 

For eigenvalue calculations additional starting points for the 

two dimensional search can be read in from card or console in one 
implementation* or input graphically via joystick and 

crosshairs in another implements t ion. 
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Hod* shape calculations require the Input of the eigenvalues for 
the system for the node for which the shapes are to be calculated, 
boundary conditions, and the number of points at which the shape Is to 
be calculated for each bean element. 

To calculate the Inverse Fourier transform to obtain the time Im- 
pulse response, the frequency response must first be calculated with 
equal spacing between calculations (IIXB) . The results are stored on 
disc to be used by the FFT algorithm. The specification of the total 
number of points to be used and the frequency range they cover Is 
input by card. 

N ature of Program Output 

The program output is of the nature described in Table 4. In cases 
where there are erreys of data (such as the values of frsquancy response) 
this data can elthar ba plotted or plotted and prlntad to allow mora 
praclaa comparisons. In this csss thara la also a selection of which 
endpoint etete variables sre to be plotted. The three types of fre- 
quency plots era tha Bode diagram. Polar plot of magnltuda va. phaaa, 
and tha mod if lad polar plot which can ba utad In stability analysis 
for certain nonlinear arm tlemsnta. Tha ^aphics assisted eigenvalue 
search program also yields s plot of the roots as they sre found. 

Numerical , Difficulties 

Tha arms modeled to date have resulted In few numerical difficulties. 
Tha difficulties encountered and ways of dealing with them era de- 
scribed below. 

False Roots in Eigenvalue Search . For a damped arm syataa tha frequency 
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determinant Is * complex number . Evaluated et the system eigenvalue 
both rial and Imaginary parts should be aero. Since conventional root 
finding algorithms deal only with real values, alternative methods 
must be found. At present the procedure is to minimise the complex 
modulus via a pattern search program developed by Prof. D.E. Whitney. 

The global ainimums must be sero, but the search routine mav return 
false eigenvalues corresponding to local minimums. These can usually 
be detected by simply looking at the modulus value. When the modulus 
value is near sero there is a possibility that the nonsero determinant 
is due either to the finite word else of the computer or to the fact 
that a false root has been returned. To resolve this ambiguity one can 
look at the real and imaginary parts of the determinant. If an actual 
system root has bean returned , and it is a single distinct root, the 
real and imaginary parts must both change signs in the neighborhood of 
the root. In normal operation where the change in roots with design 
changes is being observed the user confidence in root positions is high, 
and only when unexpected root locations are returned is the doubt suf- 
ficient to check the sign change. The experience has been that this 
check seldom falls to confirm a root whose determinant value was 
reasonably low (say less than 0.1). What is considered ‘‘reasonably 
low" varies with the arm and the position of the root. 

Convergence to the Wrong Eigenvalue Since the eigenvalue search 
be see lta actions on the shape of the determinant modulus over the 
complex plana, it will converge to different roots depending on 
where the search la begun. Thus one can repeatedly "find" the same root 
and not find a if aired root. Under these circumstances graphical 
display and input becomes very helpful, allowing the user to quickly 
modify the starting point of the eearch based on the displayed results 
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of the previous search. Search routines specifically designed to take 
advantage of the particular problem of complex root finding might 
do much better and cut down on the user interaction required. 

A more critical numerical problem arises when it is practically in- | 

possible to make the routine coverage to a root that exista. This has 
been observed for ew.reme values of arm servo control parameters. 

It corresponds to shapes of the determinant that change very rapidly 
In the region of the eigenvalues. It seems to be aggravated by two roots 
which are very close. Fortunately whan this happens it also seems 
that the root changes very slowly with parameter changes so that roots 
determined with different parameter values can be used. 


Numerical Overflow In only one case hee the problem of numerical over- 
flow been encountered. The problem was solved for that cats by using 
axtnndad computer word size, which may not ba practical in all casts 
for all eomputara. 
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PART II 

Characterisation of the Ana Servo — Structure Interaction 
Two Equal Link Example 

In an effort to characterise the Interaction of the Joint servo 
control and the structural flexibility of typical arm configurations 
the following study was undertaken. The most typical of general purpose 
arm configurations seems to be one with two long beam like segments 
of approximately equal length with rotary joints. An additional short 
segment Incorporating the end effector is also typical but will not 
be considered In this study. 

The beam segments In this study are considered to be identical 
In all properties but have different boundary conditions. They are 
Joined by a servo controlled rotary joint.. This "elbow" joint is 
assumed to operate on the position and velocity error feedback of the 
Joint* analogous to a rotary spring and dashpot. One end of the tut 
link arm has free boundary conditions and the other end is clamped to 
ground in the first case* and in the second case is connected to ground 
via a rotary "shoulder " joint with the same control scheme as the elbow 
joint. 

The modeling process discussed in Part 1 was used to obtain the 
dynamic characteristics of the two cases. The display of the dominant 
eigenvalues is relied on heavily to convey the changes in system ba~ 
havlor due to changes in joint servo control parameters. In some 
cases this is supplemented with the frequency response and time impulse 
reeponse due to end point force dletrubances. The frequency determinant 
was analytically simplified for this study as described in Appendix A. 


Two Link. One Joint Case 

First let ue consider the two identical link, one Joint cas* il- 
lustrated In Figure 9. This cess Includes distributed bean dynamics 
on either side of a controlled joint. It proves to be very informa- 
tive because after nondimena localization the results for the complete 
range of Independent parameters can be displayed on one plot of the 
root loci. 

Nocd inane localizati on of Parameters 

Table 5 displays the important physical parameters for this problem 
and a set of convenient nondlmensional groupings. They are nondimenalonal 
frequency (complex) 3 which Is multiplied by /~T~ to obtain the eigen- 
value, the nondlmensional servo frequency and damping ratio Z, . The 
servo frequency would result from a rigid Inertia equivalent to that 
of the outer link with only the joint position feedback. 


Aa observe*! in Figure 10 and in Figure 11 in more detail this simple 
ceee has root loci which fell into three characteristic groups as 


tollowa: 

e* 

le <4 

« 

.386 


2. W 

m 

.386 

3 . Ui 

» 

.386 


Appearing in Figure 12 ere the higher order roots that are not 
dominant . 

Low Servo Bandwid th (Figures 10a end lie) 

For ceee 1 with u» much lees then .386 rad. /sec. and C not much 
greeter then 1.0 the behavior is essentially that of a rigid arm. 

For C < 1 the complex conjugate roots r^ end rj near the origin in- 
dicate oecllletory behavior. For C Juet greeter then one the reel 
roote indicate overdamped behavior. There will theoretically elao be 
vlbratlone of an infinite number of modes of the distributed beams. 
Their effect will be less Important In most cease because their time 
constants ere several times higher end their amplitudes several times 
lower then the lower, dominant modes. As ; is increased past one, one 
of theee reel roote, r^» moves toward the origin and r^ moves away 
from the origin, eventually meeting e third root, ty moving toward 
the origin. Further increases in C causa r ^ end r^ to become complex. 
As C gets very large theee roote move in an ere and approach the 
imaginary axle. The value they approach is the clamped elbow natural 
frequency of the arm, which le the value one on the vertical axle of 
the nondimens lonal plot of Figure 11. 


Table 5. Nondiaensional and Physical Varlablaa for the Two 
Flexible Link. Ona Joint Cats 


Physical Varlablaa Nonane la tur a 

Joint position feedback Min (angular) k 

Joint valoclty faadbaek gain (anular) c 

Fraquancy (complex) oj (-Ja) 

Maas danaity / unit langth U 

Total an langth l 

Stiffness product Cl 


(E ■ Young's modulus and 1 « cross sectional area moment 


Dima na Ions 
LF 

LFT 

T _1 

ft 2 l " 2 

L 

2 

FL 

of inertia) 


From these variables wa construct for convenience: 

First natural fraquancy of a cantilevered beam of langth 1 


w 



Servo fraquancy for a rigid arm structure 


U 



If one replaces EX and p as independent dimensional parameters with 
u> c and ona can form the following nond imams Iona 1 groups: 


Nomliaeanional Variable 
Frequency 
Servo frequency 
Servo damping ratio 


Nomenclature 

Grouping 

w 

«/» 

c 

w 

t) /to 

s 

a c 


— 


V * % 
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C ritic al Servo Bandwidt h (Figures 10b and lib) 

As Is Increased , the point et which r^ and r^ join the real 
axis, end the point et wnlch r 2 end r 3 leave the ineginery axis nova 
closer together. For a critical value of found numerically to be 
about 0.386 these two points neat and there exists a triple root for 
C * 0.915 in the region of (-.67 + jO.O). In this region the position 
of the roots is vary sensitive to slight variations in and This 
critical point seens to be the farthest from the origin that the 
nearest root of the arm can be located, and thus the fastest overdamped 
response of these dominant roots obtainable with simple joint position 
and velocity feedback. 

Hl flh Servo Bandwidth (Figures 10c and 11c) 

For » 0.386 the root locus plot looks quite different than for 
» « 0.386. A single root r 3 remains on the real axis moving toward 
the origin as ; increases. The two complex conjugate roots r^ and r^ 
remain imaginary for all values of C. They move from a value on the 
Imaginary axis for C«0, through an almost semicircular path to a point 
whose value is the clamped elbow natural frequency. As becomes 
larger the sealcirclea become smaller and the real root becomes more 
negative for the same value of damping ratio C. In this region the 
spring is too stiff to allow motion which would dissipate the Vi- 
brational energy of the beam. This is essentially a poor match 
batmen the mechanical impedances of the structure and joint for 
the purposes of dissipating energy. 

C onclus ions and Summary for Two Link, One Joint Case 

Figure lid displays contours of constant position feedback gain 


(equivalent to constant w # ) for a wide rang* of values of w # . Also 
indicated In dashed lines are the contours of constant £. This plot 
shone the transition fro* the rigid to the floppy extreme cases for 
the lowest complex conjugate pair. 

Conclusions one eight support with a graph of this type include; 

1) Through careful design one nay be able to achieve dominant ays ten 
eigenvalues on the order of one -half or more of the lowest clamped 
joint naturax frequency using this simple control. For example eee 
w./w, m 5t C * 0.8. 

2 ) Noticeable deviations from rigid behavior become apparent when 
the eigenvalues of the rigid dynamics are of a magnitude of about 
one-fourth the lowest clamped joint natural frequency. For example 
see w # /w c “ 0.33. Excitation of the higher modes by periodic exci- 
tations may require that flexibility be considered for any arm. 

i) Consideration of arm flexibility becomes crucial whan a rigid 
design procedure produces dominant eigenvalues the magnitude of 
which is greeter then one-third the lowest clamped joint natural 
frequency. A rigid analysis of the behavior would Indicate that in- 
creased velocity feedback would result in Increased damping on the 
dominant complex root pci.*. The opposite result occurs in the actual 
flexible system and the affect la to decrease damping for the complex 

conjugate pole pair. See for example w /u • 0.5, C ■ 0.8. 

• c 

The case for two joints with this same control schema discussed in 
the following section supports these conclusions. Additional factors 
which should be considered are unequal beam cross section, payload and 
actuator masses, and a more sophisticated control. 
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Two Link. Two Joint Cam 

Having considered tha two link ona joint caaa tha naxt logical 
atap in complexity la two llnka and two joints. Thla configuration 
more raaanblca an actual manipulator although whan tha additional 
joint ia locked or if tha joint drlva la aalf locking and not balng 
driven tha prevloua raault la mora raaliatlc. Tha atap la made with 
conaldarable incraaaa In tha difficulty with which ona can thoroughly 
under* t and tha caaa. With tha simplifying aaaumptlon* of identical 
llnka and feedback constrained to two varlablea per joint one must 
deal with four independent parameters in tha flexible caaa after 
nondlaanalonallclng tha problaa and establishing the nominal joint 
angles about which vibration la balng studied. While this is not 
so great as to prohibit meaningful exploration of the case, it makes 
compact and intuitive display impossible . 

Limiting Casa - Rigid Links 

In order to establish bounds for tha flexible link behavior we 
will first consider tha limiting case of rigid links. In ona nominal 
position thla case can be described by three nondlmensional para- 
meters as shown in Table 6. As chosen hare these correspond to non- 
dimension gains In t'i feedback of tha velocity and position of the 
proximal or shoulder joint and the velocity of the dlatal or elbow 
joint. The probler is no n d inane localised with respect to the total 

arm length, tha elbow position feedback gain and the uudamped natural 
frequency with the shoulder joint clamped. 

Lagrange's equations ware used to develop the frequency function 
for the rigid link case and that development is sketched briefly 
In Appendix B. For the constrained feedback the rigid motion la very 


. /> 
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clot* to th«t of « double pendulum for small vibration*. 

Nondimenalonalisatlon of Two link. Two Joint Exampla 

By nondimenaion* liiing th* two equal link, two joint case va can 
reduce a problem of eight parameters to one of five parameters. For 
root locus plots one of these parameters is the location of the roots 
which will be a function of the other four parameters. The choice of 
nondimensional groupings will depend on convenience and the physical 
significance to the problem at hand. In the case of two links and 
one joint the choice was Influenced by the prior understanding of 
a simple second order system which was the limiting case as the links 
became very rigid relative to the Joint. When two joints are present 
the rigid counterpart is a fourth order system which la generally 
not nearly go intuitively comforting. 

By retaining nondiaenalonallsatlon compatible with the rigid analysis, 
however, we can draw on our previous analysis and readily see when there 
is a significant departure from the rigid behavior. Thus we chose the 
nondlmanalonal groupings of Table 7 which enables us to see in what 
range of flexibility the rigid analysis is valid. Notice we can move 
from the rigid analysis whose parameters appear in Table 6 to the 
flexible analysis by additionally specifying one value, the ratio of 
the clamped joint, cantilevered frequency to the rigid (clamped shoulder) 
frequency, w, / p - . 

Table 8 shows alternative parameters that will be used for improving 
on the rigid analysis when the links are eignlficantly flexible. 




X t 
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Table 6 Nondlmenslonal and Physical Variables of the Two Rigid Link. 
Two Joint problem 


Physical variables 

Nomenclature 

Dimensions 

Distal Joint position feedback gain 
(angular) 

k 2 

FL 

Distal Joint velocity feedback gain 
(angular) 

c 2 

FLT 

Proxal Joint Position feedback gain 
(angular) 

k l 

FL 

Proxal Joint velocity feedback gain 
(angular) 

U i 

FLT 

Mass Density / unit length 

U 

__2 -2 
FT L 

Total Arm length 

l 

L 

Frequency 

u 

T- 1 


Construct tha following variable equivalent to the natural frequency 
of the era with the proximal joint c leaped, and with simple position 
feedback of gain kj to the dletal joint with dimensions T 1 . 


P • 



Nondlmenslonal variables 

«am 

U 

k 



Grouping of Physical variables 
u/p 

k l /k 2 

c^lc/k^ 

c 2 lc/k 2 
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Tabic 7. Nondimenaional and Physical Variables of the Two Flexible 
Link, Two Joint Case. (For deviation from rigid analysis.) 


Physical Variables 


Nomenclature Dimension 


Distal Joint position feedback gain (angular) 

Diatal Joint velocity feedback gain (angular) 

Proximal joint position feedback gain (angular) 

Proximal joint velocity feedback gain (angular) 

Frequency (complex roots) 

Mass density/unit length 

Stiffness product (£ " Young's modulus, 

I - cross section moment of Inertia) 

Total arm length 


El 


LF 

LFT 

LF 

LF! 

„-l 


2 -2 
FT L 


FL 


From these physical variables we construct for convenience: 
First natural frequency of a cantilevered beam: 


d 


w - 3.52 S (ex fill ) 5 T 
c 


-1 


Rigid natural frequency with proximal joint clamped: 






We will use the variables w and p instead of EX and u and nondimens ional- 
ize with respect to p, k^, End i to obtain the following grouping? : 


u 

k. 


Co 


w/p 

k l /k 2 

c l p/k 2 

C 2 p / k 2 

u c /p 


BO. 


Table 8. Nondimen atonal and Physical Variables of Two Flexible Link, 
Two Joint Cat*. (Constant link parameters.) 


Phyaical Variables Nomenclature Dimension 


Distal joint position feeuback gain (angular) 

k 2 

LF 

Distal joint velocity feedback gain (angular) 

C 2 

LFT 

Proximal joint position feedback gain (angular) 

k l 

LF 

Proximal joint velocity feedback gain (angular) 

C 1 

LFT 

Frequency (complex roots) 

u) 

T ~1 

Mass density /unit length 

M 

ft 2 l~ 2 

Stiffness product (E - Young 'e modulus, 

I « cross section moment of inertia) 

El 

m 2 
FL 

Total am length 

SL 

I. 


From then* phyr -.al variables we construct for convenience: 

Pirat natural frequency of a cantilevered beam: w « 3.52 /(ElT if) 

Cantilever beam endpoint rotational spring constant: a * EI/J2, - LF 

Use u) and a instead of y and El. Kondimensionalize with respect to 

A, Li ® and a to obtain: 
c 


u 


C 1 

~ C 2 


U)/U 


k^/u 

k 2 /a 

c.u /ct 
1 c 

c,w /a 
l c 


an- 
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Performance Criteria 


When dealing with the flexible or rigid case one needs to develop 

soma criteria for good dynamic performance. While some criteria are 

obvious such as stability, others depend on the specific application of 

the arm and in the practical design case are almost always the result of a 

combination of subjective designer opinion and constraints of weight, power, 

or previous design decisions. The quadratic cost function of linear optimal 

control is a popular way to specify performance but is more the result of 

mathematical convenience than a correct estimation of the cast. 

For an Indication of how different criteria can result in different 

systems refer to Figure 13. It displays eigenvalues of optimal fourth 

order systems by three criteria: Integral of Time times Absolute Error 

(ITAE) , Solution Time criterion, and a quadratic cost function developed 
( 7 ) 

by Townsend v ' for manipulator arms. Townsend's control gains resulted 
in all overdamped roots and a rather sluggLsh system, The other two cri- 
teria , ITAE and solution time, result In four underdamped roots and there- 
fore a much faster response, but with some overshoot. 

In an effort to make this analysis Independent of the criterion 
selected the roots of the arm in a broad range of configurations which 
might be termed acceptable will be discussed. 

The transient performance of systems with various root pole place- 
ments and desirable placements for poles is extensively discussed by 

/o\ 

Graham and Lathrop . v * 

(I's 

' ' Townsend, Allen L. Jr., "Linear Control Theory Applied to A Mechanical 

Manipulator" SM thesis, Dept, of Mechanical Engineering, 
Massachusetts Institute of Technology, January, 1972 

(8) Graham, Dunstan, and Lathrop, R.C., "The Synthesis of 'Optimum' Transient 

Response: Criteria and Standard Forms". Transactions 

of the AIEE Vol.72 part 2, November, 1953. 
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Feedback Control Configuration and Its Limitations 

As suggested previously the control configuration which is being 
considered in this section is not complete state variable feedback, even 
in the rigid case. This wou) d involve feedback between the joints (inter- 
joint feedback) as well as within the joint (intrajoint feedback). Fo u r 
additional feedback gains would be involved, two velocity and two position 
gains. The additional complexity would enable complete freedom in the 
rigid case of placing the eigenvalues of the system where ever desired 
and in some arms the improved performance may well be worth the added comp- 
lexity. Such interjoint feedback is extremely rare in arms produced today, 
even experimental arm®. In fact many arms do not have velocity feedback 
and are dependent of friction in drive trains which is highly variable 
from unit to unit, and cannot be readily controlled. 

Thus while we can achieve many acceptable pole placements it would 
be accidental if we could achieve the optimal, even if that optimum 
were validly and precisely defined. For example we cannot match the 
eigenvalues dictated by the standard forms of the tTAE or solution time 
criteria or in general duplicate the eigenvalue! of a quadratic cost 
optimal system. More complete feedback would give one more degrees of 
freedom in placing system eigenvalues arbitrarily, freedom not available 
in the present case. The feedback gains determined from the matrix Riccattl 
equation for a quadratic cose criterion for example assumes all measured 
state variables can be fed back to any control variable. 

The justification for this simplif icalton then is that it more adequately 
describes the practical problem. This constraint in feedback is not entirely 
a simplification. Design techniques for complete state variable feedback 
are more readily available than for restricted feedback. 


42 


Discussion of the Root Loci-Two Link, Two Joint Rigid Link 


Figure 14 display* the location of tha complex conjugate root pair 
for the caee in question with no veolcity feedback or damping. Me will 
reference the roots aa r^ r^, r^, and r 4 where r^ * r 2 * and r^ - r^*, 

The lower indexes refer to roots nearer the origin. The relative position 
of the damped roots is determined by the ratio of postion feedback at 
the two joints k^/k 2 . This relation is displayed in Figure 15. In the 
nondlmenslonal caee considered the lower root asymptotically approaches 1 
as the Inboard "spring" k^, is made stlffer, k^ remaining fixed at l. 

The position of these roots is moved to the left as the velocity is fed back 
with increasing negative gain. The series of Figures 16a through 15d shows 
these variations in detsll. 

For any value of k^/k 2 * the r00t ® can be brought to the negative real 
axle by increasing c^ and c 2 appropriately. The difficulty arises in achieving 
sufficient damping for the pslt r^ and r 2 without greatly overdamping roots 
r^ and r^. For relatively low values of k^/^ (see Figure 16a) it is impossible 
to achieve a damping of the order of 0.7 on r. and r 2 without bringing the 
roota r^ and r^ down to become two real roots, one of approximately the same 
>\agnltuda as r^ and r 2> For values of k^/k 2 "2a reasonable response can be 
obtained of a third order nature for Cj» 6.5 c 2 • 0.1. As noticed in Figure 
16, r^ and r 2 are much nearer the origin but this can be compensated for by 
increasing k 2 when dimensional values are completed, thus shrinking the scale 
of the plot. 

As kj^/kg is increased to 5 and 10, higher values of c 2 are required to 
dump the lower modes sufficiently. The high values of both c^ and c 2 in 
turn overdamps the higher modes, bringing a slow real root near the origin. 
However, as k i /k 2 continues to increase to 50 (see Figure 16d) the lower 
mode becomes essentially independent of c^» and its damping can be controlled 
by c 2 at will. This approaches the one joint case. For kj/k 2 - 50, c.^ • 2, 
c • 1,7 the two complex conjugate pairs will both have damping greater than 
0.7. 

Thus there are many parameter values where performance might be satis- 
factory. The one perf erred would depend on the application at hand. The area 
with k 1 /k 2 large seema preferrable in terms of performance but the higher gains 
would require larger shoulder motors if the operation is to remain within 
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the linear range. This la feasible however. It may be difficult to 
achieve the low values of damping desired at the Joints especially when 
large gear reductions ere involved.. 

When k^/k^ is smell (the two gains are more nearly equal) , the lower 
pair of roots remains much .carer the origin. (Figure 16a). 

To have a response of comparable speed in a system with this control it is 
necessary to have a higher kg* which has the effect of shrinking the 
nondlmenslonel scales of Figure 16. This may not be deslreable since a 
larger value of k^ requires more torque if the response is to remain linear. 

This requlrss more massive motors and drives at the outer joint, or 
compliant transmission shafts which aggravate the vibration problems. 

Shift from Rigid Roots for Flexible Links 

To demonstrate the change of the roots as the links become more and 
more flexible, examples were chosen from the rigid case which had reasonable 
root locations. Appearing in Figure 17 are the following cases, nondlmenslonel- 
ized as in Table 7. 



* 2 
• io 
- 50 



5 



■ 15 

■ 10 



For each case the stiffness parameter of the arm is varied from one to 
10 and the root position is plotted. This is not presented as evidence of 
the limits of flexibility for reasonable performance, but as evidence of the 
limits of a rigid design procedure. As u> decreases the complex conjugate 
root pair, r^ and r^ become less damped in all cases, moving from the position 
of the rigid root. The real root near the origin in these cases moves nearer 
the origin indicating a slower response. For k^ “ 10 it is observed that the 
rigid root near the origin does not move but an additional real root moves 
in causing similar effects of slower response and Increased phase shift. 

Several things can be observed qualitatively from these three examples. 
Higher values of position feedback k^ result in the complex conjugate pair 
being more sensitive to in., Initially one might think that this favors lower 
for more flexible links. This is not conclusive since to get a conparabls 


speed from the two lyitou 


* larger value of p 


‘VaTT^Sr 


10 and k^/kj m 50 one would have to uee 
when moving to dimensional parameter*. 


If one need p • 2 for the caaa kj/k^ “10, u £ -w c p would also double. The 
praaent nond Imensionallsat ion scheme Indicate* limit* of the rigid analysis 
but 1* not well adapted to Improving on that analysis. For this reason 
a slightly different schema will now be used which fixes the links while 
allowing us to vary all the parameters of the joint control system. 

Improvement on Control with Constant Flexible Link Parameter* In order to 
demonstrate how one might improve on the servo control parameters using the 
flexible model we will take an example from Figure 17. First we will convert 
from the nond laens lonal parameters of Table 7, which allowed ease in comparison 
to the rigid case • to the nond lmens lonal parameters of Table 8, which holds 
the structural parameters constant and displays directly what we can accomplish 
with the control. The case chosen for demonstration is: 

Variable Structural Parameters, Cpjfftan^Jtructui^al Parameter* 


(Table 7 and Figure 17) 
50 

T5c - 2 


(Table 8 and Figure 18) 
lt- x - 6.5 
t 2 - 0.13 


First the velocity feedback gain "c^ to the outer Joint is varied until 
a maximum damping on the complex root pair Is found as shown in Figure 18. 
Then c^, the velocity feedback to the Inner joint Is varied until the alw 
real root moves in. slowing the response. If the max im u m damping ratio 
shown in the figure of 0.58 is not adequate for the application at hand, 
other values of k^ and k^ could ba tried or the slow real root with slow 
response would have to be tolerated. 

Effect of Structure Dynamic Rlaidlty Requirements on Gross Motion Speed 

The locked actuator natural frequency of an arm can be Increased by a 
redistribution of mass as well as by making the entire arm more rigid. This 
may involve a taperad structure of relocation or actuator masses. This re- 
location requires power transmission channels such as shafts, cables, or 
hydraulic lines which add both weight and compliance, at least partially off- 
setting the Improvements. 
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Whan It la necessary Co lnc?*ase the structure's cross section 
slse In otder to Increase gross motion times suffer as described 

below. The value of u Increases linearly with r» the radius of the 

c 2 
structure's cross section, and the Inertia of the arm Increases as r < 

The task time t^ to perform a gross motion of given angle can be ehovn to 

increase as r and thus as assuming no gravity and a bang-bang control 

strategy with maximum torque T . 

One might consider what penalty one must pay for operating conserv- 
atively at a smaller ratio of u / u than is necessary. Consider moving 

sc 

from the limiting case of u / to • 0.5. to the slightly conservative case 

sc 

of u j / 01 -0.3, by Increasing r, with a damping ratio of .65 in both 

1 c 

cases In the limiting case the n^ndimenslonal root is 80X farther from 

the origin than tne conservative case. This operating at u / to - .3 

s c 

would require an 80S larger value of r at the expense of an 80% Increase in 
gross motion time. 

The minimum value of r established by strength considerations may be 

larger than the minimum required to yield a sufficiently high value of w . 

For a bending moment T applied to a beam, we can show that the minimum 

B 1/3 

value of crors sectional radius r^ is proportional to T and that 


( 10 ) 


U) 

c.min 



where lie the total length of the arm. 

As discussed previously w determines the minimum settling time and thus the 

c 

fine motion control speed. A comparable gauge of gross motion speed with 
bang-bang control of the second link inertia is 


( 11 ) 



oC 

min 





Jt 1 * 1 


It is postulated that there exists a preferred ratio of gross motion speed 
to fine motion speed. If so, equations (10) and (11) might indicate when the 
structure cross section is lower bounded by the gross motion speed require- 
ments (via ma x i m um torque) and when it is lower bounded by the fine motion 

speed requirements (via w ). Viewed alternatively It might indicate 

c 


when we muse increase r from r fflin to achieve an adequate value 

of w . Aa T increases or l decreases the ratio of w . /(0/t*) 
c a c,nin r 

will Increase and the value of r will tend to be determined 

by minimum strength requirements with the resulting w c adequate 

to achieve fine motion control. When T decreases and l 

m 

increases the tendency will be for the u> c resulting from * min to 

be to low requiring r > r . for adequate fine motion control. 

win 

These simple relations cannot predict where the limiting condition 
will change, only the tendency or relative change as the arm 
parameters change. 
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APPENDIX A 

Analytical derivation of Frequency Functions 
CASE 1 ; One Joint, Two Links 

X — <4* — l — 


— 
n- einnad lolnt vitl 


] 


pinned joint with spring and dashpot 


The relevant state variables et each point in the system 
-v • deflection perpendicular to the x axis 
^ - angle or slope of neutral axis with x axis 
M ■ moment vector out of plane of vibration 
V • sheer in the direction of v 

The relations between the state variables at each end of the two identical 
beam segments Is given by the transfer matrix for a Bernoulli Euler beam. 


* 

K 


* V , 


left 



ileft 

• bright 


c o 

U 1 

* c 2 

sic, 


c 0 

“l 11 

ac 2 

B^Cj /e 

B 4 Lc 3 /e 

c o 


B 4 c 1 /et 

B 4 c 2 /a 

B 4 c 3 /1 

C 0 


r-vi 

M 

V 
L J 


right 


c Q • (cosh B + cos B )/2 
c 1 - (slnh B + sin 8 )/2 

j 

c_ - (cosh B - cos B )/2B 


L 2 L 
B - « 1 u/EI 

e -‘l 2 m 


c, - (slnh B - sin B )/2B' 


Where 


A-2 


and 

U 

m 


U> 

Ml 


E 

• 


I 

m 

Across the joint 


-v- 



* 

u 


M 



V 

» « 



left 


density /unit length 

circular frequency of vibration 

Young's Modulus 

cross sectional area moment of inertia 


•left “ K * ri * h * 


0 0 0’ 


M 

-v 

1 1/k 0 



0 10 


M 

0 0 1 

j 


V 

• * 


right 


0 




■ 


k • k^ + Jw c 


k^ * spring constant 
c * damping coefficient 

j * /T 

Let • the state vector at the left end of the arm 
• the state vector at the right end of the arm 

Then U B il ’ 

if B describes the identical beam segments and K. describes the spring loaded 
joint 

Boundary Conditions require 


Sq “ 

a* * 

-Wrf* 0 

\ 

h m 

r 


v° 




M0 


M, *0 


L v o J 


1 

o 

■ 

f-i 

> 

1 



1 
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Thu* the equation 

*0 • °ii 

t 

Contain* a homogeneous oet of equutior.fi 

'“u “l * “l2 «1 ■ 0 

-“21 W 1 + “22 K -0 

For this always to be true the determinant of the submatrlx cf U mutt * 0 1.6. 


11 

U 12 

‘ 2 1 

u 22 


All that is required la a great deal of algebraic, manipulation and this requite- 
aent can be expressed in term* of the elements of the matrices A end K as follows: 


-#inh a B (1 v 2 cos a 6) + cos 2 ft + 6i tcoa a B sinh 8 cosh B 

2kT 

- cos 0 sin B cosh 1 8 ] * 0 


As •» the expression 

-einh a B (1 - 2cos a B ) + cos a 8 ■ 0 

dominates. This is equivalent to expressions for single beams of length 2 SL . 

As k_ 0, c -*-0 
* 

cos a B sinh B cosh 8 - coo 8 sin 8 cosh 2 8 “ 0 


dominates and it. equivalent to pinned htams without springs or dashpots. 


Finally as K1 becomes very large 8 "♦ 0, a-* 0 and via a series expansion 
of the trigonometric and hyperbolic function the frequency condition can be 
shown to converge to 


w* 


3k 

Ui 


o 


Which is true for * simple second order system with inertia yi /3 


CASE 2 sTwo Joints, Two Links 
C0rttro\i€(j jOlAtS 



Nov U - l^B K 2 B 

which is equal to the transfer matrix 

in the one Joint example premultiplicd 
by 


Let us designate this as U * D 
The frequency determinant requires 
evaluation of additional terms. 


f o 

o 

© 

H 


r 1 

a ll 12 

0 1 1/1^ 0 


d 2l d 22 

0 0 1 0 


d 31 d 32 

o 

o 




The frequency determinant is 


U 11 

U 12 

m 

d u 

*U 

U 21 

U 22 


d 21 + 

d 22 + ^ 




*1 

*1 


d ll d 22 " d l2 d 21 + d ll d 32 - d 12 d 3 1 » 0 

v V J \ h 

determinant for 
the one joint case 

requires only that and d^ he evaluated since the detailed procedure 
for the one Joint case would give and d^ ** 
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*11 


• coa*B + sinh*6 + BA (sinh 6 ♦ tin 8) (cosh S -cos 8 ) 

4k*a 


d., ■ A (cosh 8 sinh 8 + co* 8 sin 8) ♦ t* (sinh*B - sin*B) 

12 T 


The values of d^ end d ^ are found by multiplication and simplification 
to bat 

d,. ■ 8j!A (cosh B - cos 8) (sinh B - sin B) + B* (cosh 2 S -cos*8 
J 4«k 2 2s 

+sinh a B + sin a 6) 

d*, * 8*1* (sinh 8 - sin 8) 1 ♦ BA (cosh 8 sinb S -cos 8 sin B) 

** aa^kj a 


i 


Thaaa expressions, or values obtained froa them, can then be fed into the 
frequency det eminent. 
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Rigid Body Analysis of Two -Link. Two-Joint Case 



I- ■ mass moment of Ino.i •. 
about c.g. of link 1 

I 2 “ mass moment of Inertia 
about c«g< of link 2 


m^» ©2 11(188 links 1 :nd 2 


Two Link Two Joint Arm 


The kinetic energy of the system for smell angles end i|> 

A 2 

1 “ -i- K *1 + + Vl>*i + (I 2 * h 2 ,, 2 ) *2 + VlVlV 


The potential energy (with no gravity) with rotary springs of constant k^ and k^ 
at the joints 

v -_i_ [yj + 1 2 (* 2 . ^)»i 

* 4 



Lagrange's equations require for i « 1,2 that 


For the homogeneous solution to Unoar differential aquations 

*• a * 

\ “ W 

where u - frequency of vibration in radians/sec. 

Computing tha approprlata darlvatlvas and arranging the results in matrix 
form yields: 


k l +k 2~ CI l 4tt l h i 4 ®2 i l ) w * 

,1 

“ k 2 h 2 i l n 2 W i 

l 

1 

* ** 
h 


* • 
0 

-V h 2hV 

w 



h 

* •* 




Tha dataralnant of the A x 4 matrix must be sero, which gives a condition 
for determining tha natural fraquanelaa w. 

Equal Links 


If tha two links are identical (Bl) simplifies to 



m 

ki+k2*"4mi l w t /3 

*■ 

-kj-i a mw */2 


* <q 

*1 

__ 1 

0 

(B2) 

-k 2 -i 4 aw a /2 

k .-slV/3 

" M 


*2 

la* * * 


0 

L J 


where i » • ij* B " *i “ *2 r i " l 2 “ * 

which expands and simplifies to 
(83) \k 2 - —il w * ®k 2 > + ^ m 2 4* u» 4 *0 

Equation (83) will be used to obtain natural frequencies in both the damped 
and undamped cases. 
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Undamped Natural Frequencies 


If we make the eubetltution of variable* Into equation (B3) 
9 m t* u* 


*2 


and divide by k? we obtain 


(B4) 


k l ” <k l + 8> q * + — q * “ 0 

1 1." tr 4 


The variable q correspond* to the natural frequency with the Inboard joint 
clamped. The solution of (B4) yields two roots which are a nondimensional- 
lsed form of the natural frequencies of the original problem. 


Damped Natural Frequencies (complex ) 

The damped case can be obtained directly from~equ*tion (B3) by a change 
In notation . 

kj. =*5* k 1 + Ju'c 1 
W 2 k 2 + J a) c 2 

* nd e « j w I « m 4*/ 3 

The characteristic squat Ion for determining the values of a is 

7**74 + a*!^ + 8c 2 ) + * a [I(k l ♦ «k 2 > - c^) + sfc^ + k^} + k^ - 0 






Figure 1. Stata Victor for Arm Modali 
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Figure 3a. Distributed beam Transfer Matrix 


B 


where 


Distributed Dcai Transfer Matrix (Timoshenko model) 


0,-ICi 

! 

/[r, ■(»♦ r)r,] 

act 

P 

El 

Cc - rez 

jki-rei) 

act 



c 0 - rc t 

l[e l -(» +r)cj] 


. ** 

f- 

Co-OCt 


° ~ EJ 


P “ 


£ 

EJ 

put 


EJ 


OA, 
♦ • ” TV ( 


Cq «■ A(AJ cosh ij + AJ cos i*) 
Cj - A (^| sinh ^ sin A, j 

C| - A (cosh A l — cos Aj) 
c,-A(i.mhA 1 -is , nA 1 ) 




GA * Shear stiffness 

S 

LJ ■ bondin'* stiffness 
p • Hass per unit length 

i “ Radius of gyration of cross sectional area 
perpendicular to the beam's neutral axis 

1 “ lcnp.th of the bean 

U) ■ vibration circular frequency 



REPRODUCIBILITY Of THE ORIGINAL PAGE IS POOR. 














Figure 3b. Angle Transfer Matrix 


A =’ 


1/cos 

0 

0 

L m s cu 2 sin^ tan0 


0 0 
1 0 
0 1 
0 0 


0 

0 

0 

COS0 


- x i * A *i+i 


where : 



station i * 1 


station i 


> . m 
j-i J 


■ mass of elemunt j 


n ■ first joint (angle) element greater than i, 
or the total number of elements, whichever 
is smaller 


U) ** vibration circular frequency 


Figure 3c. Riuid !.ass Transfer Matri) 


mufti -h) WvrnoJU -h) 1 
rpico 2 mw 2 C l -h) 0 



-i " !: -i+i 



I » nass moment of inertia, 

** axis perpendicular to the 
plane of vibration, through 
the center of gravity, c.g. 


m * mass of the body 


Cxi - vibration circular frequency 



Figure Controlled Notary Joint Transfer iiatrix 


0 0 0 

1 l/Wjuu) 0 
0 1 o 

0 0 1 - 



Finned connection between two elements. Relative angle is related to the 
moment which affects each of the two elements, k (jw ) is essentially the 
transfer function relating moment to angle. In the simplest case k * 
constant a rotary spring determines the relation between angle and moment, 
g (J u) can account for feedback of angular velocity and other derivatives 
or integrals of the variable ¥ , for filter dynamics included for compen- 
sation, and for servo motor and transmission dynamics. 




Figur* 5. Frequency D«t«ralranc 



-W 

V 

Hr 



For a nontrivia! solution: 
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Figure 6 Experimental Verification - Clamped elbow joint 



Torque motor , « 

rotor Inertia • 3.98xl0”?ft-lb f -acc 
(5.75x10 nt-m- sec ) 
rods-dia.» .25 in. (,00635m) 
material - carbon steel 
joint mass - .00117 slugs 
(.0171 kg) 


payloads, aluminum 

dla. - 0.75 Ins. (.0191m) 
lenghts ( .307 ft (.0936 m) 
1.060 ft (.0183 m) 


Figure 7 Experimental Verification -pinned elbow joint 




Figure 9. One Joint, Two Link Arm Example 
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Figure 12. Higher Order Root l.oci 
Varying 


6.0 



Higher Order Roots 
£ s 0.167 

O co s /uj c = 0.383 
□ (jj s /uj c S 0.500 

Values of C appearing for each case are: 

0.0, 0.1, 0.2, 0.3, 0.4, 0.5, 0.€, 0.7, 
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Figura 16a. 
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Figure I6d. Root Loci of Son- 
dimensional Rigid Two Joint Arns: 




Figure 17. Variation in Roots with u . 
by Tablo 7. 
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